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Optimal control based dynamics exploration 
of a rigid car with load transfer 

Alessandro Rucco Giuseppe Notarstefano John Hauser 



Abstract 

In this paper we provide optimal control based strategies to explore the dynamic capabilities of a single-track 
rigid car which includes tire models and load transfer. Using an explicit formulation of the holonomic constraints 
imposed on the unconstrained rigid car, we design a car model which includes load transfer without adding suspension 
models. With this model in hand, we perform an analysis of the equilibrium manifold of the vehicle. That is, we 
design a continuation and predictor-corrector numerical strategy to compute cornering equilibria on the entire range 
of operation of the tires. Finally, as main contribution of the paper, we explore the system dynamics by use of 
novel nonlinear optimal control techniques. The proposed strategies allow to compute aggressive car trajectories and 
study how the vehicle behaves depending on its parameters. To show the effectiveness of the proposed strategies we 
compute aggressive maneuvers of the vehicle inspired to testing maneuvers from virtual and real prototyping. 

> 

Q ' I. Introduction 

l/^ ■ A new emerging concept in vehicle design and development is the use of virtual vehicles, i.e., software tools 

that reproduce the behavior of the real vehicle with high fidelity Q. This allows to perform dynamic tests 
before developing the real prototype, thus reducing costs and time to market. This engineering area is called virtual 
prototyping. 

In order to explore the dynamic capabilities of a car vehicle or to design control strategies to drive it, it is 
• 1-^ . 

' necessary to develop dynamic models that capture interesting dynamic behaviors and, at the same time, can be 

H ■ 

I described by ordinary differential equations of reasonable complexity. Many models have been introduced in the 

literature to describe the motion of a car vehicle both for simulation and control. Starting from the simplified bicycle 
model, higher complexity models can be designed by adding different car subsystems such as tires, suspensions, 
the transmission system, the differential and the engine H, ||5l, ||6l, Q, (SI. The bicycle model is a planar rigid 

An eai'ly short version of this work appeared as (T\: differences between this early short version and the current article include a much 
improved comprehensive treatment, new results on the proposed model, revised complete proofs for all statements, and a new experimental 
computation scenario. 
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model that approximates the vehicle as a rigid body with two wheels. It is widely used in the literature since it 
captures many interesting phenomena concisely. However, this model does not capture some important dynamic 
effects. One of them is load transfer. The most natural way to model load transfer would be to add suspension 
models. Using an idea independently developed in ||9l, see also ifTol . we will model tire normal loads by means 
of the reaction forces generated at the vehicle contact points by the ground. This allows to model load transfer 
without adding suspension models, thus with a reasonable increase in the model complexity. 

Car dynamics analysis at maximum performance has been widely investigated in the literature. We provide an 
overview of the relevant literature for our work. First, an analysis of the equilibrium manifold for race vehicles is 
performed in ifTTl and ifTOl . In particular, existence and stability of "cornering equilibria", i.e. steady-state aggressive 
turning maneuvers, and bifurcation phenomena are investigated in these papers and references therein. Aggressive 
non-steady state cornering maneuvers for a rally vehicle were proposed in |9| (see also [12]), and llT3l . In ||9| 
trajectories comparable with real testing driver maneuver were obtained by solving a suitable minimum-time optimal 
control problem, whereas in fl3\ stability and agility of these maneuvers were studied. In llT4l minimum-time 
trajectories of formula one cars were designed by means of numerical techniques based on nonlinear programming. 
In ifTSl and |fT6l the influence of the vehicle mass and center of mass on minimum-time trajectories was studied. 
Recently, in iflTl a constrained optimal control approach is pursued for optimal trajectory planning in a constrained 
corridor. A Model Predictive Control approach is used to control the vehicle along the planned trajectory. Model 
Predictive Control for car vehicles has been widely investigated, see, e.g., ifTsl and lfT9l . It is worth noting that the 
optimal control strategy proposed in the paper for trajectory exploration can be also used in a Model Predictive 
Control scheme to track a desired curve. 

The contributions of the paper are as follows. First, we develop a single-track model of rigid car that extends 
the capabilities of the well known bicycle model and generaUzes the one introduced in ||9l. We call this model 
LT-CAR, where "LT" stands for load transfer Our LT-CAR model differs from the one in ||9l for an additional 
term in the normal forces that depends on the square of the yaw-rate. Also, we provide a rigorous derivation of 
the proposed model by use of a Lagrangian approach. Namely, using an explicit formulation of the holonomic 
constraints imposed on the rigid model, we are able to model the load transfer of the car without modeling the 
suspensions. The LT-CAR model can be seen as the limit of a model with suspensions whose stiffness goes to 
infinity. A preliminary version of this mathematical idea was proposed for a rigid motorcycle model in |20|, see 
also ED. 

Second, with this model in hand, we perform an analysis of the equilibrium manifold of the vehicle. Namely, we 
study the set of cornering equilibria, i.e. trajectories of the system that can be performed by use of constant inputs. 
We design a numerical strategy based on zero finding techniques combined with predictor-corrector continuation 
methods 1221 to compute the equilibrium manifold on the entire range of operation of the tires and parametrize it 
with respect to the lateral acceleration and the velocity of the vehicle. We show slices of the equilibrium manifold 
for a saloon car and a sports car with respectively front- wheel and rear- wheel drive transmissions, ll23l . Moreover, 
we investigate the structure of the equilibrium manifold with respect to variations in the horizontal position of the 
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center of mass. Moving the center of mass from the rear to the front causes a significant change in the structure of 
the equihbrium manifold giving rise to interesting bifurcations. 

Third and final, we develop a trajectory exploration strategy, based on novel nonlinear optimal control techniques 
introduced in ll24ll . see also ll25l . and show its effectiveness in understanding complex car trajectories on two testing 
maneuvers. In the first test, we perform an aggressive maneuver by using a multi-body software, Adams, to generate 
the desired curve. The objective of this choice is twofold: (i) we show the effectiveness of the exploration strategy 
in finding an LT-CAR trajectory close to the desired curve, and (ii) we validate the LT-CAR model by showing that 
the desired curve, which is a trajectory of the full Adams model, is in fact "almost" a trajectory of the LT-CAR 
model. In the second test, we perform a constant speed maneuver on a real testing track (a typical maneuver for 
real vehicle testing). We show how to design a full state-input desired curve (from the assigned path and speed) 
by use of a quasi-static approximation and compute an optimal trajectory that shows a typical driver behavior in 
shaping the path to keep the speed constant. 

The rest of the paper is organized as follows. In Section|ll] we introduce and develop the car model. In Section Hill 
we characterize the equihbrium manifold of the car and provide a comparison between two significant choices of 
the car parameters. Finally, in Section |IV] we describe the strategy for trajectory exploration and provide numerical 
computations performed on a virtual track and a real racing track. 

II. LT-CAR MODEL DEVELOPMENT 

In this section we introduce the car model with load transfer (LT-CAR) studied in the paper This model is an 
extension of the one proposed in |j9l, ifTOI . We model the car as a single planar rigid body with five degrees of 
freedom (three displacements and two rotations) and then constrain it to move in a plane (three degrees of freedom) 
interacting with the road at two body-fixed contact points. The center of mass and the two contact points all lie 
within a plane with the center of mass located at distance b from the rear contact point and a from the front one, 
respectively. Each contact-point/road-plane interaction is modeled using a Pacejka's tire model |26|. A planar view 
of the rigid car model is shown in Figure [T] The body-frame of the car is attached at the rear contact point with 



s 




Fig. 1: LT-CAR model. The figure show the quantities used to describe the model. 



x-y-z axes oriented in a forward-right-down fashion. We let x = [x y z]^ G M.^ and R G SO(3) denote the position 
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and orientation of the frame with respect to a fixed spatial-frame with x-y-z axes oriented in a north-east-down 
fashion. R maps vectors in the body frame to vectors in the spatial frame so that, for instance, the spatial angular 
velocity lo'^ and the body angular velocity are related by cj'* = RuJ' and lJ' ~ EFuj'^ . Similarly, x'' = x + Rn^ 
gives the spatial coordinates of a point on the body with body coordinates x** e K'^. The orientation R of the 
(unconstrained) rigid car model can be parameterized (using Roll-Pitch- Yaw parametrization) as follows 

C^Ce —S^ C^Sg 
S^Ce S^Sg , 

— Sg eg 

where and -0 are respectively the pitch and yaw angles (we use the notation — cos(?/'), etc.). In the rest of the 
paper, for brevity, we use the notation cj) — {ip,6). The vector 

q ^ (x, y, i/j, z, Of ^ {qr, qcf 

provides a valid set of generalized coordinates for dynamics calculations. The coordinates qr — {x,y,ip)'^ are the 
reduced unconstrained car coordinates, while qc — (z, 6)^ are the constrained coordinates. 

A. Tire models 

We model the tire forces by using a suitable version of the Pacejka's Magic Formula ll26l . |l27l. Before, we 
clarify our notation. We use a subscript "/" ("r") for quantities of the front (rear) tire. When we want to give a 
generic expression that holds both for the front and the rear tire we just suppress the subscript. Thus, for example, 
we denote the generic normal tire force /^, meaning that we are referring to ffz for the front tire and fj-z for the 
rear one. 

The rear and front forces tangent to the road plane, and fy, depend on the normal force and on the longitudinal 
and lateral slips. The longitudinal slip k is the normalized difference between the angular velocity of the driven 
wheel uJw and the angular velocity of the free-rolling = Vcx/^w, with Vcx the contact point longitudinal velocity, 

K = = . 

t^O Vcx 

The lateral slip (or side-slip) /3 is defined as tan/3 ~ Vcy/vcx, with Vcy the lateral velocity. We assume that the rear 
and front forces tangent to the road plane, fx and fy, depend linearly on the normal forces. Thus, the combined 
shp forces are 

fx = -fzfxo{n)9xi3{k,l3) = ~fzlJ.x{K,l3) 
fy = -fzfvo{li)gvk{k,P) = -fzHy{K,l3), 

where the pure longitudinal slip fxci^), the pure lateral slip /i,o(/3) and the loss functions for combined shp 
gx0{K,(3) and gyk{K, j3) are defined in Appendix lAl together with the values of the parameters used in the paper. 

The front forces expressed in the body frame, /^^ and f^^, are obtained by rotating the forces in the tire frame 
according to the steering angle S, so that, e.g., /^^ — ffxCs — ffySs- Substituting the above expressions for ffx 



R = R{ib,e)^Rz{i^)Ry{e) = 
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and ffy, we get 

ffx = -ffz{f^fxinf,l3f)cs - fify{Kf,l3f)ss) 
•■= -ffzilfx{Kf,Pf,S). 

In the rest of the paper, abusing notation, we will suppress the 'tilde' and use ^fx{Kf, f3f, 5) to denote ^fx{Kf, Pf,S). 

We assume to control either the rear slip and set Kf = (rear-wheel drive) or the front slip k f with Kr — 
(front-wheel drive). We denote k the controlled slip. Thus, the control inputs of the car turn to be: 

> K, the rear or front longitudinal slip, 

« S, the front wheel steering angle. 

Remark 2.1 (Longitudinal slip as control input): The use of the longitudinal slip as control input is present in 
the literature, e.g., |[T9l and ll20l . This choice does not limit the applicabiUty of our analysis. Indeed, wheel torques 
can be easily computed once a trajectory is computed. □ 

Next, we introduce a simplified tire model that will be used to design approximate trajectories (trajectories 
of a simplified car model) characterized by contact forces that can not be generated by the Pacejka's model. 
This simplified tire model, H, ||23]| . Il28l . relies on the following assumptions: (i) the longitudinal force is directly 
controlled, (ii) the relationship between the lateral force fy and the side slip /? is linear, and (iii) the longitudinal and 
lateral forces, fx and fy, are decoupled. We call the simplified car model obtained by using this tire approximation 
the Linear Tire LT-CAR (LT^-CAR). 

Figure |2] shows the plots of the longitudinal and lateral forces fx and fy for the Pacejka's and linear tire models. 




(a) (b) (c) 



Fig. 2: Pure longitudinal (a) and lateral (b) forces are plotted as function of respectively longitudinal and lateral slip for three 
values of the normal force. In (b) the simplified tire model (dashed line) is also shown. The longitudinal versus lateral force is 
plotted as function of the longitudinal slip for different values of the side-slip (c). The ellipse of maximum tire forces is shown 
in solid red. 



Remark 2.2 (Other tire models): Tires are one of the key components of the vehicle and have an important 
impact on the performance. To capture the complex behavior of the tires several models have been developed in 
the literature ll26l . ll29ll . ll30l . We highlight that the LT-CAR model can be developed with any tire model (not 
necessarily the Pacejka's one). □ 
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B. Constrained Lagrangian dynamics 

Next, we develop the constrained planar model of the rigid car that allows to include the load transfer. To describe 
the motion in the plane, we derive the equations of motion of the unconstrained system and exphcitly incorporate 
the constraints (rather than choosing a subset of generahzed coordinates). This allows to have an explicit expression 
for the normal (constraint) forces. 

We derive the dynamics of the unconstrained system via the Euler-Lagrange equations. To do this, we define the 
Lagrangian C as the difference between the kinetic and potential energies C{q, q) = T{q, q) — V{q). The equations 
of motion for the unconstrained system are given by the Euler-Lagrange equations 



dt dq dq 

where U is the set of generalized forces. Exploiting the Euler-Lagrange equations, we get 

M{q)q + C{q,q) + G{q) = U 



(1) 



(2) 



where M{q), C{q,q) and G{q) are respectively the mass matrix, the Coriolis vector and the gravity vector. 

The longitudinal and lateral forces arising from the tire-road interactions at the front and rear contact points, 
/ = {ffx,ffy,.frx,fry]'^, are Converted into the generalized forces U by using the principle of virtual work. 



< f,v^p>=< U,q >, where v^^ — [vi'^,v^'y,v^^,v^y] are the longitudinal and lateral velocities at the front and 
rear contact points. Computing the Jacobian matrix J/((i)) mapping q to the front and rear contact point velocities 
expressed in the body frame, v^p = Jf{(j))q, we get < Jf{<j))'^ f, q >=< U, q >, so that 



u = Jj {<!>)/. 

The front and rear contact points coordinates expressed in the body frame are Xj = 
(0,0,0)"^. The coordinates in the spatial frame, respectively = {xf.,y^,zf.) and Xy. 
and = x + i?Xj, so that the velocities in the spatial frame are given by = x and 

v}=x + Rw^ X xj. = X - Rx^f X w'' = X - Rx)j^t.{^)^, 
while the velocities expressed in the body frame are 



(a + 6,0,0)^ and x^ = 
= (a;^,2/|,zp, are x^ = X 



Thus, the Jacobian J/ turns to be 

Jf{4>) = 















1_ ^ry J 





c^ce SijiCe 
—s^ (o -I- b)ce 

c^ce s^ce 
—s^ 

Next, we constrain the contact points to the road plane in order to compute the normal tire forces as reaction 
forces. We impose the constraint that the rear and front contact points have zero velocity along the z axis. The 



-S0 



-se 
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A{qy- 



(3) 



velocity constraints ai-e given by Zr = x — Jyt^ {(j))q — 0, and zf — ei^ {R x — Xy J^^b = •^uj ('A)? 0' 
where Zr and Zf are the position of the rear and front contact point expressed in the body frame, respectively. The 
front and rear constraints may be written in the form A{q)q = 0, where 

c^se s^se ce -{a + h) 
c^,sg s^se cg 

From the principle of virtual work, we get the vector of constraint generalized forces, Uc, in terms of the contact 
points constraint forces, A = [//z frzY" ^ Uc — A^{q)\. These forces will be incorporated into the equations 

of motion allowing the explicit calculation of the front and rear contact point forces, fjz and frz- 

In the next theorem we show that, under the linear dependence of the contact point forces on the normal ones, 
the constrained system can be explicitly written as an unconstrained ordinary differential equation. 

Theorem 2.3 (Special structure of the constrained system): Given the unconstrained car model with structure as 
in (|2]l and the constraints (|3]l, the following holds true: 

(i) the dynamics of the constrained system can be written in terms of the unconstrained coordinates qr = [x, y, t/)]^ 



and the normal forces A = [ffz frzY' ^ 



M{qr) 



as 

Qr 

X 



+ C{qr,qr) + G{qr) =11, 



(4) 



where 



Mlliqr) 
M2l{qr) M22{qr) 



m 





—mbs^ 











m 


mbc^ 








—mbs^ 


mbc^ 


Izz + mb^ 

















-1 


-1 




—mhs^ 





a + b 






C((7r,gr) 



Ci{qrAr) 



-mbc^ip^ 
-mbs^ij)^ 




Giiqr) 

02 (gr) 





(Ixz + mhb)Tp^ 







-mg 
mgb 



(5) 



(6) 
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U = 



Wi 



Sip Cip Sip Ctp 

a+b 



ffx 

ffv 

frx 
fry 



(V) 



(ii) the subsystem 



Mll{qr)qr + Ci{qr,qr) + Ql{qr) = Ui (8) 

is a Lagrangian system obtained from a suitable reduced Lagrangian Cr{qr), with constraint forces 

M2l{qr)qr + A^22('7,)A + C2{qr , ir) + ^2(gr) = 0; 

(iii) under the assumption that the forces / depend linearly on the normal forces, i.e. / = FX, the car dynamics 
turns to be 

qr 



M{qr,fJ.* 



X 



+ C{qr,qr)+G{qr) = 



(9) 



with 



M{qr,tJ-* 



Mii{qr) Mi2iqr, ^J-**) 
M2liqr) M22{qr) 

Proof: To prove statement (i), we use Lagrange's equations ([T]) including all the coordinates (even the con- 
strained ones) and plug the constraints directly into the equations of motion (rather than attempting to eliminate the 
constraints by an appropriate choice of coordinates). The constraints are taken into account by adding the constraint 
forces into the equation of motion as additional forces which affect the motion of the system. Hence the constrained 
equations of motion can be written as 

M{q)q + C{q, q) + G{q) = jj{q)f - {q)X 

A{q)q + A{q)q = 0, 

where M, C, G and A are the one introduced in (|2]l and (O. The constraints lead to qdt) = qdt) = qc{t) = 0, 
Vi £ M, so that we have 

[M{q)q + C{q, q) + G(g)] |,,=o - [ " A^(g)A] |,,=o 



where 



M{q%^=o = 



Mi(qr) Miiqr) 



m 




-mhc^ 





m 
mbc^ 


—mhs^ 



—mbs^ 
mbc^ 
mb^ + Iz: 









m 



-mhc^ 
-mhs^ 


mb 



mb lyy + m{b'^ + h^) 
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9c =0 



-{a + b) 

and C{q,q)\q^=Q, G{q)\q^=o, Jj {q)f\q^=o are given by (|5]l, Q, and (|7]) respectively. We rewrite the equations of 
motion with respect to the extended variables [qr^ A]"^ as 



[Mi(qr)\A' 



X 



+ C{qr, qr) + Q{qr) 







(10) 



Defining M — [Mi{qr)\A^], the special structure (|4]i follows. 

To prove statement (ii), we compute the reduced Lagrangian Cr{qr) — T{qr,qr) ~ V{qr) and derive the Euler- 
Lagrange equations. Explicit calculations, shown in Appendix |B] lead to equation (|8]l. The expression of the 
constraint forces follows from the arguments to prove statement (i). 

Finally, to prove (iii), if the forces / depend linearly on the reaction forces we have / — FX, for a suitable F, 
then we can rewrite the generalized forces as 



Hi 



— Jf {qr)\qa=0 











































Sii/lfx + C^fJ-fy 


Sip fir X H~ Cipflry 


{a + b)iify 


















A := - 



Ml 



so that equation (fTOl i becomes 

M{qr 



qr 


+ 





A4l2(l7r,At**) 




qr 


X 












X 



c + g = Q 



from which equation (|9j follows directly. ■ 
We call the matrix in (|9]) the extended mass matrix. 
Remark 2.4: Equation (|9]l can be exploited as 

[Ci + gi + Mi2M^^{C2 + g2)] 

X^-M^i{C2+g2+M2iqr)- 

From this expression it is clear that we have a dynamic model explicitly depending on the unconstrained coordinates 
X, y and iJj and an explicit expression for the normal forces that can be used to calculate the Pacejka's term for the 
tire forces. □ 



December 8, 2011 



DRAFT 



10 



An important aspect to investigate for the constrained model is the invertibility of the extended mass matrix. 
Differently from the standard mass matrix, which is always positive definite (and thus invertible), the invertibility 
of the extended mass matrix depends on the model and tire parameters. 

Theorem 2.5 (Invertibility of the extended mass matrix): The extended mass matrix is invertible if and only 

if 

Proof: Clearly, a matrix is invertible (i.e. non-singular) if and only if its determinant is nonzero. By performing 
elementary row operations on the Ai matrix (Gauss-Jordan elimination method), we get the equivalent matrix 



m 














m 


mbc^ 














aflfy 















-1 











a + 6 + hfifx 


hfjirx 



With the matrix in this new form, the determinant can be easily computed and is given by det Ai = m'^Izz{—lJ-rxh+ 
a + b + iifxh), which is zero if and only if {nrx ~ l^fx) — thus concluding the proof. ■ 
Corollary 2.6: For the car parameters and Pacejka's tire model in Appendix |A1 the extended mass matrix is 
invertible. 

Proof: From the combined slip Pacejka's formulas we can show that firx and fif^ are bounded, 

IM™! = \ frxQ{n)9Txl3{K,l3r)\ < 

\fifx\ = \csffxoiO)gfxpW) - ssffyoil3)gfxi3W)\ 

< i4 + dl). 

Thus, l/ira; — /i/xl < {d^ + dl + d0 and for the data provided in Appendix lAl we have the strict inequality 
{dl +dl + dl) < so that the proof follows. ■ 



C. Dynamics in the body frame 

We provide the dynamics in the body frame with two different set of coordinates. These dynamics will be helpful 
in the characterization of the equilibrium manifold and in the exploration strategy. Indeed, expressing the dynamics 
in the body frame, we can decouple the dynamic of the vehicle from its kinematics. This allows to write a reduced 
model that includes only velocities and accelerations. 

Since the dynamics do not depend on the positions x and y, and the orientation V', we can work directly with 
the longitudinal velocity Vx and the lateral velocity Vy. To do this, note that 

VX - Vyljj 

Vy +Vx1P 



X 

y 



(11) 



Thus, we get the equations in (fT2b . 
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m 










f^rx 



















m 


mb 




l-lry 



















mh {Izz 


+ mb'^) (a 


+ b)fJ.fy 

















+ 











-1 


-1 






//. 






—mh 








a + b 


. 












mcf) 


—mvsfj 





fJ-fx 




M 


rx 










V 


msp 


mvcfi 


mb 
















$ 


mbsp 


mbvcp 


(Izz+mb^) 


{a + b)fj.fy 






























1 










—mhcp 


mhvsp 





a + b 
















—mbip^ — mvytj) 









'o 


mvxtp 












mbvx^ 


+ 















-mg 







(Ixz + mhb)ip'^ + mhvyip 




mgb 




0. 





—mv>pS0 — mbtp^ 









"o" 




—mvipci3 












+ 


mhvipcp 


+ 

















~mg 









_{Ixz + mhb)ip^ + mhvipsi3_ 




.mgb 




.0. 



(13) 



One more version of the dynamics is obtained by choosing as states the vehicle speed v and the vehicle side-slip 
angle /3, where tan/3 = Vy/vx- This change of coordinates is helpful to calculate the equilibrium manifold in the 
next section. In this case, denoting x = '4' + P the orientation of the velocity with respect to the spatial frame, we 
have 



X 




V 




V 












y 




vx 







where v and vx are the longitudinal and lateral accelerations, respectively. Finally, considering the relation (fTTI) we 
have 



V 





vijj 



and the equations of motion are given in ( fT3b . 

We have a family of car models, (fT2l i and ( fT3] l. that provide different insights depending on the features to 
investigate. The model (fT2] l is used to explore the dynamics of the car vehicle; the models ( IT2] | and (fTsT i are used 
to solve the equilibrium manifold (under usual driving conditions, it is natural to specify v and /?). 



III. Equilibrium Manifold 

In this section we analyze the equiUbrium manifold of the car model, i.e. the set of trajectories that can be 
performed by use of constant inputs. Searching for "constant" trajectories requires the solution of a set of nonlinear 
equations expressing the fact that all accelerations must be set to zero. To define an equilibrium trajectory, we refer 
to the car model in the form (fTsT l. The equilibria are obtained by enforcing 



{vj,i^)^ (0,0,0). 



(14) 



The corresponding trajectory of the full car model (including position and orientation) is a circular path at constant 
speed V, yaw rate ^ and vehicle side-sUp angle /?. Since $ = 0, the lateral acceleration is given by aiat = vi^, and 
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expressing the accelerations in the body frame as follows, 



we have 



ax 




Vx - Vy^ 




V 






Vy + Vxi^ 




vx 



ax = -aiat sin/3 
ay = aiat cos /3 
ip = aiat/v. 

Now, referring to the dynamic model (fT3] ). we set the constraints ( fT4b and we get two equations from the load 
transfer in equilibrium condition 

b {Ixz + mhb){^)^ + aiatmh sin (3 



-ffz 

~ frz 



mg 
mg 



a + b 
a 



a + b 

\2 



{I^^ + mhb){2^y + aiatmh sin (3 



(15) 



a+b a+b 
and the following three equations from the system dynamics: 

ma^ - mb-il? + fJ-fxffz + t^rxfrz = 

may + fJ-fyffz + fJ-ryfrz = 

mbay + {a + b)^fyff^ = 0. 

Substituting the expression of the normal forces ff^ and frz into equations (fTSl ), we obtain a nonlinear system 
of three equations in five unknowns {v, aiat, P, 5 and k), so that the equilibrium manifold is a two-dimensional 
surface. 

We parameterize the equilibrium manifold in terms of the car speed and lateral acceleration {v and aiat), so that 
the slip angle, steering angle and longitudinal slip 5 and k) are obtained by solving the nonlinear equations in 
03. 

We solve the nonlinear system by using a Predictor-Corrector (PC) continuation method, [221, relying on the 
continuity of the equilibria with respect to the equilibrium manifold parameters v and aiat- 

Next, we describe the PC continuation method applied to the equihbrium manifold of our car model. We fix the 
velocity v and explore a one-dimensional slice of the manifold. 

First, we provide a useful lemma from ll22ll . 

Lemma 3.1 (Lemma 2.L3, [22]): Let £ : R"+^ — M" be a smooth nonlinear function such that ^(t^o) = for 
some 770 G and let the Jacobian matrix Dg{7]Q) e have maximum rank. Then, there exists a smooth 

curve s G [0, si) c(s) G M""*"^, parametrized with respect to arclength s, for some open interval [0, si) such that 
for all s G [0, si): 

• c(0) = 7/0; 

. £{c{s)) = 0; 

• rank{Di{c{s))) = n; 
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. c(s) 7^ 0. □ 
Let f] = {aiat, P, S, k)'^ and let £{ri) = be the nonlinear system in (fTSl l. with £ : ^ M'^. The following 

proposition shows that there exists a one dimensional manifold of solution points. 

Proposition 3.2 (Equilibrium manifold well posedness): Given the nonlinear system in ( fTSl l. the following holds 

true: 

(i) there exists a smooth curve s G [0,si) H> c(s) £ M^, for some si > 0, such that £(c(s)) = for all 
s e [0,si); 

(ii) c(s) is the local solution of 

(16) 

??(0) = ?7o, 

where t{De{ri)) is the tangent vector induced by Di{rf). 
Proof: To prove statement (i), we use Lemma 13.11 The nonlinear function £ contains sums and products of 
trigonometric and power functions, thus it is smooth. Using the expression of the combined slip forces introduced 
in Section Hi- Al for t^o = (0, 0, 0, 0) we have /i,* = 0, so that it follows easily that ^(r^o) = 0. Moreover, by explicit 
calculation, the Jacobian matrix at r/o has rank three. 

To prove statement (ii), we differentiate £{c{s)) = with respect to the arc-length s. The tangent c(s) satisfies the 
equation D£{c{s))c{s) — 0, ||c(s)|| = 1 Vs £ [0,si). Hence c(s) spans the one-dimensional kernel ker{Di{c{s))), 
or equivalently, c(s) is orthogonal to all rows of Dg{c{s)). In other words, the unique vector c(s) is the tangent vector 
induced by Di{c{s)), t{Di{c{s))). Using the Implicit Function Theorem, e.g., ||3T| , the tangent vector t{Di{c{s))) 
depends smoothly on Di{c{s)). Thus, c is the solution curve of the initial value problem in ( fT6] l, which concludes 
the proof. ■ 

In order to numerically trace the curve c efficiently, we use a Predictor-Corrector (PC) method. The main idea is 
to generate a sequence of points along the curve rji, i = 1,2, . . ., that satisfy a given tolerance, say ||^(77j)|| < i' for 
some v > 0. So, for ly > sufficiently small, there is a unique parameter value Si such that the point c{si) on the 
curve is nearest to rji in Euclidean norm. To describe how points iji along the curve c are generated, suppose that a 
point ?/j G satisfies the chosen tolerance (i.e. ||^(77i)|| < i^)- If rji is a regular point of £, then there exists a unique 
solution curve Ci : [0, Si) ^ which satisfies the initial value problem ( fT6] l with initial condition 77(0) = r/j. 

To obtain a new point r/^+i along c, we make a predictor step as a simple numerical integration step for the 
initial value problem. We use an Euler predictor: 

Qfj+i = rji + et{Di(rii)) , 

where e > represents a suitable stepsize. 

The corrector step computes the point w^+i on c which is nearest to ofi+i. The point ijJi+i is found by solving 
the optimization problem 

ll^^j+i - tti+ill = min llw - Qfi+ill . (17) 
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If the stepsize e is sufficiently small (so that the predictor point cti+i is sufficiently close to the curve c) the 
minimization problem has a unique solution w^+i. We compute w^+i by using a Newton-like method. The Newton 
point J\f{a) for approximating the solution of ( fTTb is given by J\f{a) = a — De{a)H{a). 

The PC continuation method used in the paper thus consists of repeatedly performing these predictor and corrector 
steps as shown in the pseudo-code below. 

Algorithm 1 PC-continuation method 
Given: initial equilibrium condition rja such that £{rio) — 
for i = 0,1,2... do 

set the initial steplength = e; 

loop 

get predictor step: a^+i = r]i + t{De{rii)); 
search corrector term: 

if convergence then 

break; 
else 

update the steplength e^+i — ei/2; 
end if 
end loop 

Vi+i — '^i+i; 
end for 



We compute and compare the equiUbrium manifold for two car configurations, namely a saloon car with front- 
wheel drive (k = Kf) and a sports car with rear-wheel drive (k = Kr), equipped with the same set of tires. The 
parameters of the two cars and the tires are given in Appendix lAl 

Some slices of the equiUbrium manifold are shown in Figure [3] For low longitudinal and lateral slips a first class 
of equilibria appears. These equilibria are close to the ones with the linear tire approximation (the solid lines in 
Figures [3al and [3bl and Figures [3i] and [3j are close to the dot lines). Indeed, for low slips (/3r,Pf < ^[deg] and 
K < 0.005) the tires work within their linear region as appears in Figures |2a] and |2b] To characterize the vehicle 
behavior in this region, we can use, lH], the understeer gradient 

d5{aiauv) 

Kus[aiaUV) = Ka, 

oaiat 

where Ka = is called Ackerman steer angle gradient. The vehicle is said to be understeering if K^s > 0, 
neutral if K^g = and oversteering if K^g < 0. From a graphical point of view, the understeering behavior can be 
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a|„[g] a|_,[gl a^la] i^\a] 

(e) (f) (g) (h) 



Fig. 3: Equilibrium manifold for the front-wheel drive saloon car (a)-(d) and for the rear-wheel drive sports car (e)-(h). Specifi- 
cally: rear and front side slip, longitudinal force coefficient, steering angle, and maximum eigenvalue for v — (10, 20, 30, 40)m/s. 
Dash lines in (a)-(b) and (e)-(f) are the equilibria with linear tire model al v = 20m/s. The dash-dot line in (c) and (g) is the 
Ackerman steer angle. 




(a) (b) (c) (d) 

Fig. 4: Equilibrium manifold for the rear-wheel drive sports car for different positions of the center of mass. Specifically: 
rear side slip, front side slip, longitudinal force coefficient and steering angle for v — 40m/s, b = (1.1, 1.3, 1.5)m and 
a + b = 2.45m. In (d) the red diamond markers show three equilibrium points with steering angle opposite to the direction of 
the turn (counter-steering). 



measured by looking at how much the curve aiat ^ ^{aiat, v), for fixed v, departs from the fine aiat *^ Kaaiat- As 
shown in Figure |3c] for the saloon car the steer angle gradient is slightly positive, which suggests an understeering 



behavior, except in the case of v ~ 10 [m/s] (slightly oversteering). For the sports car. Figure 3g we observe a less 
understeering (nearly neutral) behavior Kus — at higher speeds. 

For high values of the longitudinal and lateral slips the equilibrium manifolds depart from their linear-tire 
approximation. Indeed, the Hnear tires, without force saturation, allow to generate a lateral force for any lateral 
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acceleration. In this region we can not use the understeer gradient analysis, thus we study the stability of the 
equilibria. The stability is investigated by calculating the leading eigenvalues (those with largest real part) of the 
linearized system with respect to the equilibrium states. In this region the equilibria are unstable for the saloon car, 
see Figure [3dl and stable for the sports car, see Figure [3h] 

The PC-continuation method allows also to perform a sensitivity analysis of the equiUbrium manifold with respect 
to the car parameters (as, e.g., mass, moment of inertia, center of mass position). In Figure |4] we highlight the 
results obtained when varying the center of mass position along the body longitudinal axis. By setting the sports car 
inertial parameters, we compute the manifold varying the value of a and b with constant wheelbase a + b = 2.45m. 

As far as the center of mass stays between the rear contact point and the half wheelbase, the equilibrium manifold 
(Figure |4] blue line) is structurally the same as the one in Figure l3el [3fl and [3gl When the center of mass is moved 
over the half wheelbase toward the front axle the manifold has a significantly different structure (green and red 
lines). In particular, the equilibria at highest rear lateral and longitudinal slips, highlighted with the red diamond 
markers, are achieved with steering angle opposite to the direction of the turn (counter-steering). This car set 
up resembles the one of rally cars which, indeed, take advantage of the counter-steering behavior in performing 
aggressive turns. 

The significant change of the equilibrium manifold with respect to the position of the center of mass suggests 
that the equilibrium manifold sensitivity analysis can be used as a design tool to optimize the car performance. 

IV. Nonlinear optimal control based trajectory exploration 

In this section we describe the optimal control based strategies used to explore the dynamics of the car vehicle 
and provide numerical computations showing their effectiveness. 

A. Least-square optimization for trajectory exploration 

Complex dynamic interactions make the development of maneuvers highly nontrivial. To this end, we use 
nonlinear least squares trajectory optimization to explore system trajectories. That is, we consider the optimal 
control problem 

min l|x(r)-Xd(r)||| + ||u(T)-u<i(T)||2jdr 

+ i||x(r)-x,(r)fp^ 

subj. to x(t) = /(x(t), \x{t)) x(0) ^ xo, 
where Q, R and Pi are positive definite weighting matrices, for z e M" and W G M"^" \\A\'w = z^Wz, and 
(xrf(-), U(j(-)) is a desired curve. The desired curve is a trajectory exploration design parameter, i.e., it is a naive 
guess of a system trajectory that the designer uses to explore the trajectory space. Here the weights Q, R, and Pi 
are design variables that reflect the relative importance (and/or confidence) of certain components of the desired 
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trajectory. Writing the least squares trajectory functional as 



1 ^'^ 



H^;U)^^ I ||x(T)-x,(T)||$ + ||u(r)-u,(r)||^dr 



+ -||x(T)-x,(r)||l,^ 



^1 

with ^ = (x(-),u(-)) and £_d — (xd(-), Ud(-)), and denoting T the manifold of bounded trajectories (x(-),u(-)) on 
[0,r], the optimization problem can be written as 

minh{C,U). (18) 

To facilitate the local exploration of trajectories of this highly coupled nonlinear system, we use the Projection 
Operator Newton method developed in 1241 . 

We take a trajectory tracking approach, defining a projection operator that maps a state-control curve (e.g., a 
desired curve) onto the trajectory manifold. Specifically, the time varying- trajectory tracking control law 

x{t) =f{x{t),uit)), x(0)=Xo, 

(19) 

u(i) + K{i){a{t) - x{t)) 

defines the projection operator 

mapping the curve ^ to the trajectory rj. 

Using the projection operator to locally parametrize the trajectory manifold, we may convert the constrained 
optimization problem ( fTsT i into one of minimizing the unconstrained functional .g(C;Crf) = ^(^(O^Crf) using, for 
example, a Newton descent method as described below. A geometric representation of the projection operator is 
shown in Figure |5] 



r = ne) 



Fig. 5; Geometric representation of the trajectory manifold: every point of T is a trajectory of the system. The projection of 
the curve £f — (a(-),/i(-)) on T through V is the trajectory ^* — (x(-),u(-)). 



Minimization of the trajectory functional is accomplished by iterating over the algorithm shown in the table, where 
indicates the current trajectory iterate, an initial trajectory, and ( i-^ Dg{^i;£^d) ■ C and ( i— D'^g{£^i;£^d){CX) 
are respectively the first and second Frechet differentials of the functional g{^) = h{V{^);(,d) at ^i. 
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Algorithm 2 Projection operator Newton method 
Given: initial trajectory ^ T 

for i = 0,1,2... do 

design K defining V about 
search for descent direction 

G = ai-g min ^a) ■ C + lD^9i^^■,U)iC, C) 

step size 7^ = arg min^g(o,i] + jQ); 
project = + 7»G)- 
end for 



The algorithm has the structure of a standard Newton method for the minimization of an unconstrained function. 
The key points are the design of K defining the projection operator and the computation of the derivatives of g to 
"search for descent direction". It is worth noting that these two steps involve the solution of suitable (well known) 
linear quadratic optimal control problems, ll24l . 

B. Exploration strategy 

The projection operator Newton method, being a descent method, guarantees the convergence to a local minimum 
of the optimal control problem in ( fTSl l. A naive choice of the desired curve and the initial trajectory may let the 
algorithm converge to a (local minimum) trajectory that is too far from the desired curve and does not contain 
useful information on the vehicle capabilities. In order to deal with this issue, we develop an exploration strategy 
based on the following features: (i) choose a desired curve that well describes the desired behavior of the vehicle, 
but is not "too far from the trajectory manifold", (ii) embed the optimal control problem into a class of problems 
parametrized by the desired trajectory, (iii) design a continuation strategy to update the desired and initial trajectories 
of the embedding problems. 

First, we describe how to choose the desired curve. The path and the velocity profile to follow on that path, 
are usually driven by the exploration objective. Thus, the positions Xd{t) and yd{t) and the velocity Vd{t), with 
t G [0, r], of the desired curve are assigned. For example, in the next sections we describe two maneuvers where 
we want to understand the vehicle capabilities in following respectively a chicane at "maximum speed" and a real 
testing track at constant speed. 

How to choose the other portion of the desired curve (i.e. the remaining states and the inputs) strongly affects 
the exploration process. In order to choose this portion of the desired curve, we use a quasi trajectory that, with 
some abuse of notation, we call quasi-static trajectory. 

Given Xd{t), yd{t) and Vd{t) (and thus (Td{t)), t G [0,T], for each t G [0,T], we impose the equilibrium 
conditions (fT4l l for the desired velocity and path curvature at t. That is, posing Vqs{t) — Vd{t) and ipqs{t) = 
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Vd{t)<Td{t), we compute the corresponding equilibrium value for the sideslip angle, I3qs{t), the yaw rate, -ipqsit), 
and the yaw angle, %ljqs{t), together with the steering angle, 5qs{t), and the longitudinal slip, Hqs{t), by solving the 
nonlinear equations (fTsT l. Thus, the quasi-static trajectory {xqs{t),\Xqs{t)), t £ [0,r], is given by 

^qs{t) ^[Xd{t), yd{t), ^Jqs{t), Vd{t), I3qs{t), Vd{t)<Td{t)f , 
Uqs{t) ^[Sqs{t), Kqs{t)f . 

Remark 4.1 : We stress that the quasi-static trajectory is not an LT-CAR trajectory since it does not satisfy the 
dynamics. However, experience shows that, reasonably, for low values of the (longitudinal and lateral) accelerations, 
the quasi-static trajectory is close to the trajectory manifold. □ 

The above considerations suggest that the quasi-static trajectory represents a reasonable guess of the system 
trajectory on a desired track for a given velocity profile. Thus, when only the desired position and velocity curves 
are available, we set the desired curve as the quasi-static trajectory. In doing this choice we remember that the 
positions and velocity profiles are the ones we really want to track, whereas the other state profiles are just a guess. 
Thus, we will weight the first much more than the latter. 

Since we are interested in exploring "limit" vehicle capabilities, most of the times, as it happens in real prototype 
tests, we will study aggressive (cornering) maneuvers that are usually characterized by high levels of lateral 
acceleration. Thus, it can happen that a quasi-static trajectory can not be found (we are out of the equilibrium 
manifold). If this is the case, we generate the desired curve by using the linear tires car model, LT^-CAR, discussed 
in Section III-AI so that every lateral acceleration can be achieved. In this way we can always construct the quasi- 
static trajectory, and thus the desired curve, from a given desired path and velocity profile. 

Remark 4.2: We could optimize on the simplified LT-CAR model, find an optimal trajectory of the simplified 
model and use that one as a desired trajectory for the actual LT-CAR model. However, we can leave the optimization 
do this operation directly on the actual model. □ 

With the desired curve in hand we still have the issue of choosing the initial trajectory to apply the projection 
operator Newton method. To design the initial trajectory, we could choose an equilibrium trajectory (e.g. a constant 
velocity on a straight line). However, such naive initial trajectory could lead to a local minimum that is significantly 
far from the desired behavior or cause a relatively high number of iterations. From the considerations in Remark l4n 
we know that a quasi-static trajectory obtained by a velocity profile that is not "too aggressive" is reasonably close 
to the trajectory manifold. 

These observations motivate and inspire the development of an embedding and continuation strategy. We parametrize 
the optimal control problem in (fTsT l with respect to the desired curve. Namely, we design a. family of desired curves 
that continuously morph a quasi-static trajectory with a "non-aggressive" velocity profile into the actual desired 
(quasi-static) curve. 

Thus, the continuation update is as follows. We start with a non-aggressive desired curve, = (xj^(-), u^(-)), 
and choose as initial trajectory, ^q, the projection of the desired curve, — V{£,]^). That is, we implement equation 
(fT9] l with (a(-),/i(-)) = {x^{-),u^{-)). Then, we update the temporary desired curve, with the new curve in the 
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family, ■f^^^, (characterized by a more aggressive velocity profile on the same track) and use as initial trajectory 
for the new problem the optimal trajectory at the previous step. The procedure ends when an optimal trajectory is 
computed for the optimal control problem where the temporary desired curve equals the actual one. Next, we give 
a pseudo code description of the exploration strategy. We denote PO_Newt(^i, the local minimum trajectory 
obtained by implementing the projection operator Newton method for a given desired curve and initial trajectory 

Algorithm 3 Exploration strategy 

Given: desired path and velocity Xd{-), yd{') and Vd{-) 

compute: desired curve — (xgs(-),Ugs(-)); 

design: f^, ie{l,...,n}, 

s.t. ned) ^ ed and q = u 

compute: initial trajectory ~ 'Pi^d)- 
tor i — I, ... ,n do 

compute: Copt = PO_Newt(C&, Q); 
set: — Qjpi\ 
end for 
Output: iopt = Cpf 



C. Aggressive maneuver on a chicane and model validation 

Virtual prototyping is the process of design, simulation, and testing of a "virtual" vehicle (i.e. a software 
mathematical model of a real vehicle). It allows to simulate testing maneuvers as, e.g., the ones required by 
international standards, thus reducing prototyping costs and time to market. Computer Aided Engineering (CAE) 
tools for virtual prototyping allow to create a full vehicle model so that physical and functional tests can be performed 
without realizing a physical prototype with a very high level of reliability. As CAE tool, we use Adams/Car developed 
by MSC. Software. Adams is one of the most used multibody dynamics tools in the automotive industry. A full 
vehicle model includes all the actual car subsystems as: steering, front and rear suspensions, chassis, front and rear 
tires, powertrain, brake system. 

We perform an aggressive maneuver by using Adams to generate the desired curve. The objective of this choice 
is twofold: (i) we show the effectiveness of the exploration strategy in finding an LT-CAR trajectory close to the 
desired curve, and (ii) we validate the LT-CAR model by showing that the desired curve, which is a trajectory of 
the full Adams model, is in fact "almost" a trajectory of the LT-CAR model. 

The desired curve is obtained as follows. We set as desired path the chicane depicted in Figure |6al To obtain 
the desired velocity profile, we set the initial velocity to 150km /h (41.67m/s), and invoke an Adams routine that 
generates a velocity profile to drive the vehicle on the given path at maximum speed under a maximum acceleration 
(amax)- The remaining desired state curves are obtained by means of an Adams closed loop controller that drives 
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the (Adams) vehicle on the given path with the given velocity profile. The desired inputs are set to zero since they 
do not have an immediate correspondence with the inputs of the Adams vehicle. They are weighted lightly, thus 
giving the optimization the necessary freedom to track the states. With this desired trajectory in hands, to "run" 
the exploration strategy, we need to define the initial trajectory and the continuation update rule for the desired 
trajectory morphing. 

The exploration strategy for this maneuver is as follows. Initially, we limit the maximum acceleration parameter 
to 50% of the desired one (amaxo = 50% a^nax)- This gives a trajectory that can be easily projected to the LT-CAR 
model to get a suitable initial trajectory. Then, we increase the vehicle capabilities of a 10% acceleration step-size 
until the desired maximum acceleration is reached. For each intermediate step, we set the Adams trajectory as 
temporary desired trajectory and the optimal trajectory at the previous step as initial trajectory. A pseudo code of 
the strategy is given in the following table. 

Algorithm 4 Exploration strategy for the chicane maneuver 
Run: Adams/Car with path = "chicane" 

compute: velocity profile with amaxo = 50% amax 
run: closed-loop driver to get 
Compute: initial trajectory = Vi^f^") 
for i = 50, . . . , 100 do 

Run: Adams/Car with path = "chicane" 

compute: velocity profile with a^axi = «% an,ax 
run: closed-loop driver to get ^^^^ 
Compute: Copt = PO_Newt(C*^°, 



end for 
Output: Cpt = i 



100% 
opt 



In Figure |6] we show the results of the numerical computations. In Figure |6b] a reasonably small (less than 0.2 
m) path error can be observed. In Figure |6c] and Figure |6d] we report respectively the longitudinal and lateral speed 
profiles followed by the LT-CAR model versus the Adams vehicle. The maximum error is less than 0.36to/s for 
the longitudinal speed and 0.22m/ s for the lateral one. Comparing Figure |6j with Figure l6cl we may notice the 
relationship between the load transfer and the longitudinal acceleration (velocity slope). The vehicle enters the first 
turn decreasing the vehicle speed (constant negative slope) and the front load suddenly increases due to the load 
transfer induced by the strong braking. After the first turn the velocity is slightly increased (constant positive slope) 
as well as the load on the rear Entering the second turn, the vehicle reduces its speed again and then accelerates 
out again. It is worth noting in Figure |6j how the LT-CAR load transfer follows accurately the Adams vehicle load 
transfer except for a high frequency oscillation (probably due to the Adams suspensions transient). We stress the 
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error path 



longitudinal velocity 




(a) The chicane maneuver, 
lateral velocity 
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(b) Error path. 



control Inputs 



, gLT-CAR 
^LT-CAR 



J 
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time [s] 




(c) Longitudinal velocity 
normal forces 




(d) Lateral velocity Vy. 



(e) Control inputs 5{md) and K(Nodim). 



time [s] 

(t) Wheel load 



Fig. 6: Aggressive chicane maneuver: profile of the relevant signals. The LT-CAR profiles are very close to the Adams ones. 



fact that there is an accurate prediction of the load transfer although the LT-CAR has not a suspension model. 

D. Constant speed maneuver on a real testing track 

In this test the desired maneuver consists of following a real testing track at constant spee(|3. In particular, we 
choose a desired speed that in the last turn gives a lateral acceleration exceeding the tire limits. For this reason 
we compute the desired curve as the quasi-static trajectory of the Linear Tires LT-CAR model, (LT)^-CAR, on the 
desired path profile depicted in Figure |7a] with velocity v = 25m/s. 

The exploration strategy for this maneuver is as follows. To morph to the desired curve, we start with a speed 
of 20m/s and increase the velocity profile of Im/s at each step. For each speed value, we compute the desired 
curve as the quasi-static trajectory of the (LT)^-CAR model on the track. As mentioned before, for the (LT)^-CAR 
model we can always find the quasi-static trajectory. The exploration strategy thus follows the usual steps. In the 
following pseudo code we denote ^^.^,2 the quasi-static trajectory of LT^-CAR obtained on the given path at 
constant velocity v. 

* See |http://www.nardotechmcalcenter.coni/ 1 for details on the track 
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Algorithm 5 Exploration strategy for the constant speed maneuver 



Given: desired path Xd{-), Vd{ ) and Vd{ ) = 25m/s 

compute: desired curve — Clj^car' 

compute: initial trajectory = ^('^lt^car)' 
for w = 20, . . . , 25 m/s do 

set: = '^LT^-CAR' 

compute: Cpt = PO_Newt(eS, CP; 
set: = Cop^; 
end for 



Output: Copt = Copt- 



In Figures |2] the optimal trajectory of the LT-CAR model (solid green) is compared with the desired curve (dash 
blue) and with the optimal trajectory of the bicycle model (dash-dot red). In particular, we choose a desired speed 
(25m/s) that in the last turn gives a lateral acceleration exceeding the tire limits. We observe that the optimal 
trajectory reaches a minimum speed at the last turn. Figure |7c] Clearly increasing the desired speed increases the 
path error. Figure |7b] 

The comparison with the classical bicycle model confirms the importance of including load transfer in the model. 
Indeed, the bicycle model is able to track the high speed profile much more accurately than the LT-CAR. This 
reveals that the bicycle model is missing important dynamic Umitations due to load transfer that will appear on the 
real vehicle. 

Next, we comment on some interesting phenomena happening in the last turn. In the first straight portion 
(highlighted with "1" in Figure |7a|i, the vehicle decelerates and moves on the right of the track to gain the 
most favorable position to enter the turn. Due to this fact the car is in full deceleration to face the right bend. 
In order to generate the required lateral forces, the tires have a high side slip angle (portion "2" in Figure |7al see 
also Figure iTdl i. Then the car starts the exit from the turn (portion "3" in Figure iTaJi. With the decreasing of the 
centrifugal force, the lateral forces on the tires decrease, so that the longitudinal slip can increase. Figure |72 and 
therefore the longitudinal forces. Thus, the car accelerates in order to regain the desired constant speed. 

V. Conclusions 

In this paper we studied the problem of modeUng and exploring the dynamics of a single-track rigid car model 
that takes into account tire models and load transfer. Starting from the bicycle model, we introduced the load transfer 
phenomenon by explicitly imposing the holonomic constraints for the contact with the ground. The resulting model 
shows many of the interesting dynamic effects of a real car. For this rigid car model we characterized the equilibrium 
manifold and analyzed how it changes with respect to suitable parameters. Finally, we provided a set of strategies, 
based on nonlinear optimal control techniques and continuation methods, to explore the trajectories of the car 
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(a) Path x-y. 
side slip (last turn) 




(d) Side-slip /3. 



path error 




time [s] 

(b) Path error x-y. 

steering angle (last turn) 
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(e) Steering angle 5. 



velocity 
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(c) Velocity v. 



longitudinal slip (last turn) 
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(i^ Longitudinal slip k. 



Fig. 7: Exploration strategy for a constant speed (25m/s) maneuver on a real testing track. The dash, solid and dash-dot lines 
represent the desired curve, the optimal LT-CAR and the optimal bicycle model trajectories, respectively. Temporary optimal 
trajectories (for v — 21, 23m/s) are in light dot lines. In subplot (a) the path portion of the optimal trajectory is shown with a 
zoom on the last turn (entering the main straight): the corner entry ("1"), the apex point ("2"), and the comer exit ("3") are 
highlighted. In subplots (b) and (c) we show the path error and the velocity on the entire track. Subplots (d), (e) and (f) show 
the side-slip, the steering angle and the longitudinal slip in the last turn where the desired constant speed gives a desired lateral 
acceleration exceeding the tire limits. 
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model. We provided numerical computations showing the effectiveness of the exploration strategy on an aggressive 
maneuver and a real testing track. 

Appendix 

A. Car model parameters 

The tire equations introduced in Section Hl-AI are based on the formulation in The pure longitudinal slip is 
given by 

fxo{i^) — dx sin {cx arctan — ex{hxH — arctan^^jK)]}, 
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the pure lateral slip by 

fyo{P) — d-y ^in- {cy arctan [byjS — ey{by(3 — arctanfoj,/?)]} 
and the loss functions for combined slips by 



gxi3{K,f3) = cos 

gyk{K,l3) = cos 
The tire parameters are based on the ones given in II271I . 



0x13 arctan (l3—^^ — : 



Cyk arctan (^ i/^f^^2 
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The mass parameters are based on the ones given in ||23i . 
Saloon car 

m=1150[fc5] a= 1.064H 6 = 1.569H h^0.57[m] 
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Adams model, based on ADAMS/Car tools of MSC.ADAMS 2005 r2 (example of four-wheeled vehicle called 
MDI_Demo_Vehicle). The tire parameters are determined by nonhnear curve-fitting routines. 
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m = 1528.68[A;5] a = 1.48[m] b = 1.08[m] h = 0.43[m] 
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Ib= 6129.12 

-1.91 6022.36 

B. Reduced order model without load transfer {bicycle model) 

The vector = [x, y, ^)'^ provides a valid set of generaUzed coordinates for dynamics calculations. So, the 
equations of motion for a Single-track rigid car with generalized coordinates qr = {x, y, 'tpY are given by 

Mii{qr)qr +Ci{qr,qr) + Ql{qr) = Ui 

where the mass matrix is 





m 





—mbs^ 


Mxi{qr) = 
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the Coriolis and gravity vectors are 

CliqrAv) = 

and the vector of generahzed forces is 
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Gl{qr) = 
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